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<§). Verfahren und Vorrichtung zur Steuerung der Bewegungen einer Maschine 

^) Verfahren und Vorrichtung zur Steuerung der Bewe- 
gungen einer Maschine mit je einem elektrischen An- 
triebsmotor 11, 12, 13 fur jede Bewegungsachse, der je- 
yyeils mit einem Geber 21, 22, 23 rnechanisch gekoppelt 
ist, wobei aus den Ausgangssignalen des Gebers 21, 22, 
23 die Position der Maschine auf der Bewegungsachse 
bestimmt werden kann, und fur jede Bewegungsachse 
nur ein Startbefehl fur den Antriebsmotor, eine Bewe- 
gungsgeschwindigkeit und eine Zielposition vorgegeben 
wird, und Bewegungen beliebiger Achsen kompensiert 
werden konnen, indem in Abhangigkeit vom Erreichen ei- 
ner bestimmten Position auf einer Achse der Startbefehl 
fur eine weite re Achse ausgelost wird. 
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Beschreibung 



Die vorliegende Erfindung betrifftein Verfahren und erne 
Vorrichtung zur Steuerung der Bewegungen einer Maschine 
rait je einem elektrischen Antriebsmotor fiir jede Bewe- 
gungsachse, der jeweils mit einem Geber mechanisch ge- 
koppelt ist, und wobei aus den Ausgangssignalen des Ge- 
bers die Position der Maschine auf der Bewegungsachse be- 

stimmt werden kann. 

Das vorliegende Verfahren und die vorliegende Vorrich- 
tung konnen bei praktisch alien Maschinen Verwendung fin- 
den, bei denen bestimmte Bewegungen koordiniert erfolgen 
mussen. Insbesondere eignet sich das beschriebene Verfah- 
ren und die beschriebene Vorrichtung fur Werkzeugmaschi- 
nen, Industriefoboter, Transport- und Be- und Entladesy- 
steme. Besonders vorteilhaft findet die vorliegende Erfin- 
dung Verwendung, wenn eine Vielzahl von Bewegungsach- 
sen oder Bewegungsvorgangen koordiniert ablaufen sollen. 

Gernafi dem bisherigen Stand der Technik konnten solche 
koordinierten BeWegungsvorgange nur mittels sehr aufwen- 
diger und komplexer Multiachssteuerungen realisiert wer- 
den^ Dabei muBte fiir jeden Bewegungsvorgang eine Reihe 
Von Punkten festgelegt werden; die von der Maschine dann 
sukzessive angefahren wurden. Die entsprechenden Ver- 
fahrwege dazwischen wurden ublicherweise durch Interpo- 
lation, meist in Form von Polynomen hoherer Ordnung er- 
mittelt. Dies erforderte stets eine sehr aufwendige Zentral- 
steuerung mit hohen Rechenleistungen sowie eine sehr auf- 
wendige Steuerung der einzelnen Antriebsmotoren. 

Es ist daher Aufgabe der vorliegenden Erfindung; eine 
solche Steuerung erheblich zu vereinfachen, sowohl was die 
Zahl der Komponenten betrifft, als auch im Hinblick auf den 
erforderlichen Programmieraufwand. . . 

ErfindungsgemaB wird diese Aufgabe durch ein gattungs- 
gemaJSes Verfahren zur Steuerung der Bewegungen in einer 
. Maschine gelost, bei dem fiir jede Bewegungsachse nur ein 
Startbefehl fur den Antriebsmotor, eine Bewegungsge- 
schwindigkeit und eine Zielposition vorgegeben wird, und 
Bewegungen beliebiger Achsen kombiniert werden konnen, 
indem in Abhangigkeit vom Erreichen einer bestimmten Po- 
sition auf einer Achse der Startbefehl fiir eine weitere Achse 
ausgelost wird. 

Auf diese Weise ist es nicht mehr notig, entsprechende 
Kurven durch eine definierte Anzahl von Punkten im Raum 
zu kennzeichnen. Vielmehr genugt es erfindungsgemaB, ei- 
nen Startbefehl fur eine Bewegung in einer Achse zu geben 
sowie eine Bewegungsgeschwindigkeit und einen Endpunkt 
in dieser eindimensionalen Achse vorzugeben. Zusatzlich 
wird ein Punkt auf dieser Achse definiert, bei dessen Errei- 
chen der Beginn einer Bewegung auf der nachsten Achse 
gestartet werden soli. Auch auf dieser Achse ist wiederum 
lediglich eine eindimensionale Bewegungsgeschwindigkeit 
und ein eindimensionaler Zielpunkt vorgegeben. Auf dieser 
zweiten Achse kann wiederum ein Punkt vorgegeben sein, 
an dem eine Bewegung in einer dritten Achse beginnen soil. 
Auf diese Weise konnen beliebig viele Achsen und Bewe- 
gungsvorgange miteinander kombiniert werden. 

Besonders bevorzugt ist es dabei, die Antriebsmotdren je- 
weils mittels eines zugehorigen Frequenzumrichters anzu- 
steuern, der bestimmte Beschleunigungs- und Bremsrampen 
speichert, denen dann der Bewegungsablauf der Antriebs- 
motoren folgt. Auf diese Weise lassen sich die Bewegungen 
der Maschine beim Hinzutreten einer Bewegung in eine an- 
dere Achsenrichtung zu beliebigen Bahnkurven verschlei- 
fen. Die Bewegungen erfolgen auf diese Weise weich und 
ruckfrei, was den Energiebedarf und deri VerschleiB der An- 
triebsmotoren erheblich vermindert, 

Weiter ist es dabei besonders bevorzugt, eine zehtrale 



Steuerung vorzusehen, die iiber einen Datenbus„ die Aus- 
gangssignale der Geber empfangt und uber. den selben Da- 
tenbus die Startbefehle sowie die vorgegebenen Bewe- 
gungsgeschwindigkeiten und Endpositionen an die Fre- 
5 quenzumrichter der Motoren verteilt. Auf diese Weise ist es 
nicht mehr notig; die Motoren aufwendig uber eine zentrale 
. Steuerung zu steuem, wobei dann von der zentralen Steue- 
rung eine Leitung zu jedem der Motoren gefuhrt werden 
muB. Insbesondere bei groBen Industriemaschinen und In- 
to dustrieanlagen genugt statt dessen ein durchlauferider Da- 
tenbus. Die Verdrahtung und Wartung des Systems wird da- 
durch erheblich vereinfacht. 

Zusatzlich kann fur jede Achse ein Referenzpunkt vorge- 
sehen sein, der auBerhalb der normalen Verfahrstrecken der 
15 Maschine liegt. Auf diese Weise kann sichergestellt werden, 
daB die Maschine bei alien Betriebsbedingungen den Refe- 
renzpunkt. anfahren kann, da er ja nicht im Arbeitsbereich 
liegt, und zusatzlich kann bei Bedarf durch entsprechende 
Geber eine Neujustierung der Maschine, beispielsweise 
20 nach Stromausfall oder Betriebsstorung problemlos vorge- 

nommen werden. 

Zur Realisierung der vorliegenden Erfindung ist eine Vor- 
richtung. besonders bevorzugt; bei der fur jede Achse ein 
Antriebsmotor vorgesehen ist, der jeweils mit einem Geber 
25 mechanisch gekoppelt ist, und dessen Ausgangssignale uber 
einen Datenbus zur zentralen Steuerung gefuhrt werden, 
wobei jeder Antriebsmotor iiber einen Frequenzumrichter 
mit Energie versorgt wird, und wobei diese Frequenzum- 
richter iiber den Datenbus mit ihren Steuerbefehlen versorgt 
30 werden. 

Es ist dabei besonders bevorzugt, als Geber Resolver zu 
verwenden. 

Im folgenden wird die vorliegende Erfindung ahhand des 
in der beigefiigten Zeichnung dargestellten Ausfuhrungsbei- 
35 spiels naher beschrieben. Es zeigt: 

Fig. 1 eine schematische Ubersichtsdarstellung einer er- 
findungsgemaBen Steuerung; 

Fig. 2 die Anordnung der einzelnen Achsen und die je- 
weiligen Referenzpunkte; und 
40 Fig. 3 den Ablauf einer kurvenformigen Bewegung, wie 
sie beispielsweise erforderlich ist, urn Waren von einem 
Forderbahd auf eine Palette umzusetzen, wobei die Waren 
uber ein Hindernis einer bestimmten Hohe hinweggehoben 
werden mussen. V 

Fig. 1 zeigt den schematischen Aufbau der Steuerung ei- 



45 

ner Maschine, die Bewegungen in drei Achsen ausfuhreri 
kann. Naturlich kann eine erfindungsgemaBe Steuerung 
auch fur nur zwei oder aber beliebig viele Achsen aufgebaut 
werden. 

50 Fiir jede Achse X; Y, Z ist ein Drehstromsynchronmotor 
11, 12, 15 vorgesehen. Auf der Abtriebswelle dieser Moto- 
ren 11, 12, 13 ist jeweils ein Resolver 21, 22, 23 angebracht. 
Dieser liefert Informationen uber Drehrichtungund Drehge- 
schwindigkeit des Motors an eiri Businterface 31, 32, 33. 

55 Diese Bustreiber 31, 32, 33 sind uber eine gemeinsame Bus- 
leitung 30 miteinander und mit einer zentralen Steuerung 40 
verbunden. Die Steuerung 40 liefert andererseits fiber den 
Datenbus 30 Steuersignale an die Bustreiber 31, 32, 33, von 
denen die entsprechenden Steuerbefehle an Frequenzum- 

60 richter 41, 42, 43 weitergeben werden. Jeder dieser Frequen- 
zumrichter 41, 42, 43 ist jeweils einem Motor 11, 12, 13 zu- 
geordnet. Vorzugs weise sind die Frequenzumrichter 41, 42, 
43 direkt an den Motoren angeordhet. Die Ausgangsdaten 
der Resolver 21, 22, 23 werden dabei vorzugs weise fiber die 

65 Frequenzumrichter 41, 42, 43 zu den Businterfaces 31, 32, 
33 gefuhrt. Dadurch verfugt jeder Frequenzumrichter stets 
iiber die Information fiber die aktuelle Position auf seiner 
Achse. 
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Die Frequenzumrichter 41, 42, 43 erhalteri uber den Da- einer Ware von einer Palette auf ein Forderband darstellen, 

tenbus 30 und die jeweiligen Bustreiber 31, 32, 33 jeweils bei:dem die Ware uber ein dazwischen befindliches Hinder- 

Befehle von der Steuerung 40, bestimmte Strecken mit einer nis hinweggehoben werden muB. 

bestimmten Geschwindigkeit zu fahren. In den Frequen- Bei Bahnsteuerungen geriiaB dem Stand der Technik 

zumrichtern 41, 42, 43 sind dazu jeweils entsprechende Be- 5 muBten fur diese Bewegung samtliche Punkte 200 bis 214 in 

schleunigungs- und Verzogerungsrampen gespeichert, da ja die .Maschine einprogrammiert werden. ErfindungsgemaB 

die Motoren nicht beliebig schnell beschleunigt werden . erhalt die Maschine jedoch lediglich folgende Befehle: 

k6nnen. Entsprechend versorgen die Frequenzumrichter 41, Beim Start am Pkt. 200 erhalt die Maschine den Befehl 

42, 43 den ihnen jeweils zurgeordneten Motor 11, 12, 13 mit "Fahre mit vorgegebener Geschwindigkeit entlang der Y- 

Drehstrom langsam ansteigender Frequenz. Da im vorlie- 10 Achse bis zii dem oberen Y- Wert* 1 . Dieser entspricht dem Y- 

genden Fall Synchronmotoren Verwendung finden, kann Wert des Punktes 208. 

uber die Frequenz die Drehzahl der Motoren genau einge- Fur die X- Achse wird lediglich vorgegeben, wenn der Y- 

stellt werden. Durch die Ausgangsdaten der Resolver 21, 22, Wert dem. Y- Wert des Punktes 202 entspricht "Bewege dich 

23 ist der jeweilige Frequenzumrichter und die Steuerung 40 mit vorgegebener Geschwindigkeit in X-Richtung bis zum 

permanent uber die aktuelle Position informiert. Dadurch 15 Erreichen des X-Wertes .des Punktes 214". 

kann der Frequenzumrichter den Motor auch rechtzeitig vor Weiter erhalt die Maschine den Befehl "Beim Erreichen 

.Erreichen des Zielpunktes mit der entsprechenden vorgege- des X-Wertes des Punktes 210 eine Bewegung in Richtung 

benen Verzogerungsrampe herunterregeln, so daB die Ge- . der Y- Achse mit vorgegebener Geschwindigkeit zu starten, 

schwindigkeit kontinuierlich auf Null abgesenkt wird, und bis sie den Y-Wert des Punktes 214 erreicht hat", 

die vorgegebene Zielposjtion mit einer vernachlassigbaren 20 Der Funkuonsablauf ist dann der folgende: 

Restgesch windigkeit erreicht wird. , Die Maschine startet am Punkt 200 und bewegt sich mit stei- 

Anstelle der Resolver 21, 22, 23 konnen natiirlich auch gender Geschwindigkeit bis zum Erreichen der vorgegebe- 

beliebige andere Wegegeber oder Impulsgeber Verwendung. nen. Geschwindigkeit in Y-Richtung in diese Richtung. 

finden. Entscheidend ist, daB aus den AusgangSsignalen des Beim Erreichen eines vprgegebenen Y-Wertes, der den Y- 

Gebers direkt oder uber Integration dieser Signale die Posi- 25 Wert des Punktes 202 entspricht, erhalt die Maschine deh 

tion der Maschine auf der jeweiligen Bewegungsachse be- Befehl, mit einer vorgegebenen Geschwindigkeit in X-Rich- 

stimmt werden kann. Es ist also erforderlich, daB die Geber tung zu fahren bis der X-Wert dem X-Wert des Punktes 214 

21, 22, 23 ein der Bewegungsstrecke oder Bewegungsge- entspricht. Die Maschine beginnt also nun in X-Richtung zu 

schwindigkeit proportionales Signal und ein Signal uber die beschleunigen. Gleichzeitig verringert sich jetzt die Bewe- 

Richtung der Bewegung Oder ein absolutes Positionssignal 30 gungsgesch windigkeit in Y-Richtung, da der Frequenzum- 

erzeugen. . , richter die entsprechende Bremskurve in Y-Richtung ab- 

Die Fig, 1 zeigt einen Aufbau fur eine Dreiachsensteue- fahrt, und entsprechend die Motordrehzahl reduziert. Beim 

rung. Es ist aber selbstverstandlich ebenso moglich, bei- Erreichen eines entsprechenden X-Wertes, der mit Sicher- 

spieisweise nur zwei Achsen ahzusteuern,.oder weitere Mo- heit jenseits des Hindernisses 220 liegt; wird ein weiterer- 

dule hinzuzufiigen, so daB nahezu beliebig viele Achsen ge- 35 Befehl ausgelost, nunmehr in negativer Y-Richtung mit vor- 

steuert werden konnen. Durch den modularen Aufbau ist gegebener Geschwindigkeit bis zum Y- Wert des Punktes 

dazu nicht. einmal eine Umstrukturierung der Anlage not- 214 zu fahren. 

wendig. Es werden einfach zusatzliche Bustreiber-Frequen-. ErfindungsgemaB ist es also nicht mehr notig, die Koordi- 

zumrichter-Motor-Resolvereinheiten an den Datenbus ange- naten X, Y der gesamten Punkte von 200 bis 214 vorzuge- 

schlossen. Die Obergrehze fur die Zahl der regelbaren Ach- 40 ben. Vielmehr wird jeweils nur ein Y- Achsen-Geschwindig- 

sen ergibt sich dann nur noch aus der Anzahl von Geraten, keits- und Zielwert vorgegeben, sowie ein Wert auf der Y- 

die maximal von dem Bus adressiert werden konnen. Selbst Achse bei dem eine X-Achsen-Bewegung beginnen soil, 

dann ist es jedoch moglich, durch Aufteilung auf mehrere Der Befehl fur diese X-Achsen-Bewegung enthalt wie- 

Bussysteme noch weitere Achsen hinzuzufiigen. derum nur Bewegungsgesch windigkeit und Zielwert. Ab- 

Irn folgenden soli das Steuerungsverfahren anhand der 45 hangig von der Position auf der X- Achse kann dann wie- 

Fig. 2 und 3 naher erlautert werden; Zur Vereinfachung der derum ein neuer Fahrbefehl in Y-Richtung ausgelost wer- 

zeichnerischen Darstellung wird hier nur eine Zweiachsen- den, der ebenfalls wieder nur eine Bewegungsgeschwindig- 

steuerung daigestellt. Die zu steuernden Bewegungen der keit (diesmal in negative Richtung) auf der Y- Achse und ei- 

Maschine verlaufen also entlang einer Y- Achse 100 und ei- nen Zielwert auf der Y- Achse enthalt. 

ner X- Achse 110.. Am Ende der jeweiligen Achsen ist je- 50 ErfindungsgemaB ist also die Steuerung und die Prograrn- 
weils ein Referenzpunkt 102, 112 vorgesehen. Dieser Refe- mierung erheblich vereinfacht, durch Einstellung der ent- 
renzpunkt ist vorzugsweise so angeordnet, daB er sich au- * sprechenden Brems- und Beschleunigungsrampenfunktio- 
Berhalb des normalen Arbeitsbereichs der Maschine befin- nen in den Frequerizurnrichtern kann zusatzlich noch dem 
det. Durch entsprechende Anschlagssc halter kann das Refe- jeweiligen Be wegungswiderstand bzw. der jeweiligen Mas- 
renzieren der Maschine auch automatisiert werden. Die Re- 55 sentragheit des zu bewegenden Maschinenteils Rechriung 
ferenzpunkte mussen dabei nicht gleichzeitig, sondern kon- getragen werden. Auf diese Weise fuhrt die Maschine mit ei- 
nen auch nacheinander angefahren werden. Erfindungsge- nem Minimum an Steuerungs auf wand und Programmierung 
maB ist dies jedoch nur noch nach dem Einschalten der Ma- flieBende Bewegungen, auch komplexester Art, aus. 
schine erforderlich. Selbstverstandlich kann jederzeit yon Als Steuerungseinheit 40 kann beispielsweise eine spei- 
den Bedienurigskraften eine Referenzfahrt der Maschine 60 cherprogrammierte Steuerung (SPS) .oder ein entsprechen- 
ausgelost werden, wobei dies erfindungsgemaB aus jeder der Mikroprozessor verwendet werden. Ebenfalls ist natiir- 
Achsenposition heraus moglich ist. lich eine Steuerung uber entsprechende CIM (Computer in- 

Ein beispielhafter zweiachsiger Bewegungsablauf ist in tegrated Manufacturing)-Systeme moglich. 

der Fig, 3 dargestellt. Hierbei sind zur besseren Erlauterung Es ist dabei besonders bevorzugt, direkt von der Steue- 

auch noch Bahnkurvenpunkte 200 bis 214 eingezeichneL Es 65 rung 40 aus uber den Datenbus 30 auch die Beschleuni- 

ist jedoch zu beachten, daB die erfindungsgemaBe Steuerung gungs- und Bremsrampenfunktionen der Frequenzumrichter 

diese Punkte nicht benotigt und auch nicht gezielt anfahrt. verandern zu konnen. Durch diese Rampenfunktionen wer- 

Das dargestellte Beispiel soil beispielsweise das Urnladen den die Bewegungen der Maschine zu beliebigen Bahnkur- 
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ven verschliffen. 

Die Frequenzumrichter jeder Achse erhalten von der 
Steuerung 40 jeweils eine Endpositions- und Geschwindig- 
keitsvorgabe, sobald eine Bewegung in dieser Achsenrich- 
tung ausgefuhrt werden soli. Gleichzeitig erhalt die Steue- 
rung dauemd Ruckmeldungen uber die aktuelle Position je- 
der Achse. Anhand der Positionswerte der einzelnen Achsen 
konnen von dem Programm der Steuerung beliebige Aktio- 
nen ausgelost werden; Auf cliese Weise ist die Zahl def Ach- 
sen, die gesteuert werden konnen, theoretisch unbegrenzt. 
Die Programmierung ist auch erheblich erleichtert, insbe- 
sondere wenn drei oder mehrere Achsen fur die Bewegung 
erforderlich sind, beispielsweise wenn die Waren von der 
Palette nacheinander abgehoben werden sollen, wobei dann 
noch jeweils Bewegungen in Z- Achse (in Fig. 3 auf den Be- 
trachter zu) erforderlich sind. Diese Z-Achsen-Bewegungen 
konnen dann unabhangig . von der jeweiligen X- und Y-Ach- 
sen-Bewegung programmiert werden. 

Patentanspriiche 
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1 . Verfahren zur Steuerung der Bewegungen einer Ma- 
schine mit je einem elektrischen Antriebsmotor (11, 12, 
13) fur jede Bewegungsachse, der jeweils mit einem 
Geber (21, 22, 23) mechanisch gekoppelt ist, und wo- 
bei aus den Ausgangssignalen des Gebers (21, 22, 23) 
die Position der Maschine auf der Bewegungsachse be- 
stimmt werden kann, dadurch gekennzeichnet, daB 
fur jede Bewegungsachse nur ein Startbefehl fur den 
Antriebsmotor, eine Bewegungsgeschwindigkeit und 30 
eine Zielposition vorgegeben wird, und Bewegungen 
beliebiger Achsen kombiniert werden konnen, indem 

in Abhangigkeit vom Erreichen einer bestimmten Posi- 
tion auf einer Achse der Startbefehl fur eine weitere 
Achse ausgelost wird. 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, daB die Antriebsmotoren (11, 12, 13) jeweils mit- 
tels eines zugehorigen Frequenzumrichters (41, 42, 43) 
angesteuert werden, der bestimmte Beschieunigungs- 
und Bremsrampen speichert, denen dann der Z^ewe- 
gungsablauf der Antriebsmotoren (11, 12, 13) folgt. 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
net, daB . eine zentrale. Steuerung (40) vorgesehen ist, 
die uber einen Datenbus (30) die Ausgangssignale der 
Geber (21, 22, 23) empfangt, und uber den selben Da- 
tenbus (30) die Startbefehle, sowie die vorgegebenen 
Bewegungsgeschwindigkeiten und Endpositioren an 
die Frequenzumrichter (41, 42, 43) der Motoren (11, 
12, 13) verteilt. . 

4. Verfahren nach Anspruch 3, dadurch gekennzeich- 
net, daB der Verlauf def Beschleunigungs- und Brems- 
rampen von der zentralen Steuerung (40) fur jede 
Achse und fur jede Bewegung separat in den jeweili- 
gen Frequenzumrichter (41, 42, 43) eingegeben wird. 

5. Verfahren nach einem der Anspruche 1 bis 4, da- 
durch gekennzeichnet, daB fur jede Achse (100, 110) 
ein Referenzpunkt <102, 112) vorgesehen ist, der au- 
Berhalb der normalen Verfahrstrecken der Maschine 
liegU 

6. Vorrichtung zur Durchfuhrung des Verfahrens nach 
einem der Anspruche 1 bis 5, dadurch gekennzeichnet, 
daB.fiir jede Achse ein Antriebsmotor (11, 12, 13) vor- 
gesehen ist, der jeweils mit einem Geber (21, 22, 23) 
mechanisch gekoppelt ist, und dessen Ausgangssignale 
uber einen Datenbus (30) zur zentralen Steuerung (40) 
gefuhrt werden, und jeder Antriebsmotor (11, 12, 13) 
uber einen Frequenzumrichter (41, 42, 43) mit Energie 
versorgt wird, wobei die Frequenzumrichter (41, 42, 
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43) uber den Datenbus (30) mit ihren Steuerbefehlen 
versorgt werden. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
net, daB als Geber (21, 22, 23) Resolver verwendet 
werden. 
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